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Abstract 


An articulated flexible manipulator carried on a translational cart is 
maneuvered by an active controller to perform certain position control tasks. 

The nonlinear dynamics of the articulated flexible manipulator are derived and a 
transformation matrix is formulated to localize the nonlinearities within the 
inertia matrix. Then a feedback linearization scheme is introduced to linearize 
the dynamic equations for controller design. Through a pole placement 
technique, a robust controller design is obtained by properly assigning a set of 
closed-loop desired eigenvalues to meet performance requirements. Numerical 
simulations for the articulated flexible manipulators are given to demonstrate 
the feasibility and effectiveness of the proposed position control algorithms. 


Introduction 


Research and experiments on control of large flexible manipulators have 
gained much attention in the past decade. The merits of flexible manipulators 
over rigid ones are light weight and small power consumption. However, the 
trade-off is in developing a feasible control scheme not only to effectively 
accomplish the assigned task, but also to minimize the flexible vibrations. 
Several investigators have studied the dynamics and control of the flexible 
manipulators [1-6] . Most flexible manipulators are composed of one or, at most, 
two flexible beam-like arms rotated by the actuators in planar motion. The 
nonlinear characteristics of the dynamic models are either linearized or 
eliminated due to their relatively small contributions. Nevertheless, the 
behavior due to dynamic nonlinearities becomes significant under quick maneuvers 
or large motions. Investigation into dynamic nonlinearities provides a very 
useful way for the feasible control design of the large flexible manipulators. 

In this paper, an articulated flexible manipulator is studied. The system 
consists of a rigid translational cart with one flexible beam-like arm attached 
on a motor at one end, and an equivalent arm hinged on the. tip at the other end. 
Two motors are concatenated axially upon the cart. The additional motor 


transmits the torque to the elbow joint through a wire to manipulate the 
forearm. This appendage expands the workspace wherein which the ti ' of the 
articulated manipulator can reach. It also develops another degret :>f freedom 
associated with the rigid body. Two kinds of interactions of kine: -ic 

nonlinearities appear significantly [7] . One is introduced througi che coupling 
of the rigid cart and the flexible arms. The other takes place due to the 
interaction of the two articulated flexible arms. 

The dynamics equations are derived using Lagrange's equations of motion 
along with classical vibration theory [8-10]. Actuator dynamics are briefly 
described and are included in the system equations to complete the dynamic model 
of the system [11] . Nonlinearities in the inertia matrix are localized using an 
appropriate transformation matrix and are linearized using a feedback 
linearization scheme [7,12,13]. A robust pole placement method [14] is then 
applied to obtain a well-conditioned output feedback controller so that closed- 
loop eigenvalues are insensitive to system uncertainties or perturbations. 
Several simulations are given to illustrate the feasibility and effectiveness of 
active position control schemes in performing translational and slewing tasks 
while suppressing flexural vibrations of each flexible arm. 


System Dynamics 

For the sake of clarity and simplicity, this section begins with the 
derivation of one-arm manipulator dynamics, then is followed by the dynamic 
model formulation for the articulated manipulators. 

a . One-arm Manipulator Dynamics : 

In Fig. 1, the single planar flexible arm is clamped on the axial shaft of 
the motor by a hinge. This motor is mounted on a translational cart which is 
driven along a linear track by another motor. The beam-like flexible arm is 

modeled as a cantilever beam with the fixed end at the motor and the free end at 

the tip x 1 =L. Only the bending vibration is allowed during the motion of the 

arm. The x-y axes are the fixed inertial coordinate, whereas, the x^-y^ axes 

represent the moving relative coordinate. Lagrange's equation of motion, in 
conjuction with the modal expansion to discretize the deflection of the flexible 
manipulators, is applied to derive the dynamic equations of motion. Denote El 
the bending rigidity, p the mass density of the arm per unit length, L the 

length of the flexible arm, and M the total mass of the cart and the arm driver. 

Let the state ^vector be defined by 

k = ( y> Sj/ qi ) T ; = ( q 13/ q 12 ' q lni ) d) 
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where y is the translational displacement of the cart, 0^ the root angle of the 

flexible arm, and (i=l,...,n 1 ) the general coordinates corresponding to the 

shape functions (i=l,...,n^) for discretization of the bending deflection of 

the flexible arm. The control torques introduced by the two motors can be 
expressed by the vector 

x = ( T o ' x i ' °' — ' 0 )T (2) 

where Tq and represent the applied torques for the cart and the flexible arm 
respectively. 

The equations of motion including actuator dynamics can then be written by 
»» . 

= f (£,4) + X (3) 

in which the inertia matrix reads 

M = 

rp A 

where the superscript T in ( ) means the transpose of the matrix ( ) , ^ is an 

n^xn^ identity matrix, and cB^ = cos(0 1 >. The constant vectors h^ and P 1 are 

defined in the appendix which also shows the detailed derivation of equation 
(3) . The constant stiffness matrix shows 

2 

K = Diag [ 0, 0, pLto^ ] ; 0)^ = Diag [ • ■ •> © ln ] (5) 

where <D^ (i=l,...,n^) are the frequencies associated with the shape functions 
Yli(Xl) , which are used to discretize the deflection of the flexible arm. The 
nonlinear force yields 


m + pL 


pL'c6 1 /2 


-h 1 c6 1 


Symmetric 


L 1 

-P, 


P L I. 


(4) 


f <£,£) 


s9 1 (pL 2 0^/2 - h^’q 1 0 1 ) 

s9 1 h l q 1 y 


j “sOj^hx^y 

where s9x = sin<8x) • 


( 6 ) 
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The actuator dynamics and sensor characteristics play major roles in the 
controller design. The two actuators for the feedback control are dc electric 
motors. The electric motor can be regarded as a standard armature circuit. 
Denote the armature resistance by R , the back-EMF (Electro-Motive-Force) 

constant by K^, the motor torque constant by K t , the gear train viscous drag 

coefficient by C v , the motor inertia by 1^, and the overall gear ratio by N^. 

Then the torque X produced by the actuator provides [11] 

T = ( N K /R )e - ( K. K. /R + C )N 2 8 - I N 2 0 (7) 

v gt a'a'tb a v ' g mg ' 

where e is the applied voltage into the armature and 8 is the output shaft 
a 

angle 8. . Note that 8 in equation (7) is identical to the root angle of the 

flexible arm. For the case of the translational cart, it is equivalent to the 
linear displacement y divided by the transmission pulley radius r. Apparently, 
the passive damping of the whole system results from the second term in equation 
(7) . 


Referring to the sensors, the rotational angles are measured by the 10-turn 
rotary potentiometers, whereas, the angular velocities are calibrated by the 
tachometers. Strain gages are used to sense the bending moments along the 
flexible arm. Denote c the conversion factor between the output shaft angle 

and the output voltage e of the potentiometer, c the conversion factor between 

P ^ 

the output angular velocity and the output voltage e , c the conversion factor 

u s 

between the strain and the strain output voltage e Q . Suppose two strain gages 
are placed along the flexible arm respectively at x^ and x 2 as shown in Fig. 2a. 
An output measurement equation can be written in the following matrix form 


e = [ e , e. , e 


't A ' t,' p Q ' pj' o 


(x 1 ) , e Q (x 2 )] = C f [y, 8^ \ ] 


T. T 


( 8 ) 


'0 -i 

= Diagfc /r, c , c /r, c , C ] [y, 8 n , y, 8 1 , q^ ] 

p n p, C i i X 


T,T 


where 


C_ = c h 
e s 


^xx^l 1 Vxx< x l> 

V l,xx (x 2 ) ,V * r n,xx (x 2 ) 


V 


(x, ) (x) /8x^ I , 

1 , XX 1 Y 1 |x=X 1 ' 
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T 

q 1 = [q^j , , q ln ] and h is the half-thickness of the flexible arm. Equation 

A 

(8) relates the output voltage e to the state variables y, 0^ and £ through the 
coefficients of the matrix C f . 


Substituting equation (7) into equation (3) provides 


m£+c£+K^= BE ft) + £(%,%) 

ci 


(9) 


in which. 


M = M + Diag {I N 2 /r, I N 2 , 0, 0] 
m 0 g 0 m l g l 


C = Diag [ <K K /R +C )N 2 /r, (K K. /R +C )N 2 0, 0 ] 

t 0 b 0 a 0 0 g 0 Z 1 1 1 1 g l 


B = 


N K. r/R 
g 0 fc 0 a 

0 

0 

0 


N a K t /R a 
g l Z 1 a l 

0 

0 


and E (t)=(e ,e ) with e, and e being the applied voltages for the motors 
a a 0 a l a 0 a l 

of the cart and the flexible arm respectively. 


b. Articulated Manipulator Dynamics: 

In order to expand the workable region of the flexible manipulators, one 
beam-like flexible arm is articulated on the tip of the previous arm as shown in 
Fig. 3. This additional arm is also treated as a fixed-free cantilever beam. 
This system has three (one translational and two rotational) degrees of freedom 
attributed to rigid body motion. One more actuator is required, which 
concatenated axially with the former one on the rigid cart . The forearm is 
manipulated by this additional motor through a wire. In Fig. 3, the mass M 
includes the mass of the new motor for the forearm. Denote 0^ the root angle of 

the first flexible arm and 8 2 the root angle of the forearm measured relative 

to the previous local coordinates, i.e., axes. 

The state vector similar to equation (1) becomes 


5 



( 10 ) 


( y / 9 ]_ / ®2 ' q l ' ^2 ) ^ ; • • 


,q ln 1 ) and q 2 =(q 21' •• 


•" q 2n 2 > 


where y is the translational displacement of the cart and (i=l,...,n^) the 

general coordinates corresponding to the shape functions (i=l,...,n 1 ) for 

discretization of the bending deflection of the first flexible arm. The 
quantities q 2 ^ and \y 2 ^ are defined similarly for the forearm. The input vector 

for the articulated flexible arms is 


x = (x Qf x 1 ,x 2 ,o, ,0) (ID 

where Tq represents the applied torque for the cart, and x ^ and t 2 for the two 
flexible arms. 

Application of Lagrange's equations of motion in terms of state variables 
yields a set of equations in matrix form as equation (3) . The symmetry inertia 
matrix becomes 

r~m+2pL ~ I 


3pL^c0 1 /2 


Symmetric 


M pL 2 c(0 1 +6 2 ) /2 pL 3 c0 2 /2 


-h^cOj^ -pLV^L) -pL^ (L)c 0 2 /2 pL^ (L)V(/[(L) 

-pL^ (L)c0 1 +pLI x 


^20(0^^4-02) -Lh 2 c0 2 


h 2 \|/^ (L)c0 2 


where c0^ = cos (6^), c0 2 = cos(02> and c (0^+02) = 003(0^+02). Here 1^ and l 2 
are n^Xn^ and n 2 ><n 2 identity matrices respectively with n^ and n 2 being the 

numbers of the mode shapes respectively for discretization of bending 
deflections of the two beam-like flexible arms. Moreover, the stiffness matrix 
becomes . 

2 ■ 2 

K=Diag[0, 0, 0 , pLG^, pLO^ ] /(D^Diag [co^, . . ,a> ln 3 and co 2 =Diag[o 21 , . . ,co 2n 3 (13) 


and the nonlinear force vector is 
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(14) 


(f 0' f l ,f 2' f 3 ,f 4 ) 

where 


f Q - 3pL 2 s0 1 0^/2 - s6 1 (h^q 1 )0 1 - s(0 1 +0 2 ) (h^q 2 ) (0 1 +0 2 ) 

+ pL 2 s (0 1 +0 2 ) 0 2 (^+©2) /2 - pLs© 1 (V^(L)q 1 ) 0 X 
f 1 = s0 1 (h^q 1 )y + s (0 1 +0 2 ) (h 2 q 2 ) y - pL 2 s ( G 1 +Q 2 ) y0 2 /2 
+pL30 1 (V^(L)q 1 )y + pL 3 s0 2 0 2 /2 - Ls0 2 (h 2 q 2 ) © 2 

f 2 = s (0^02) (h 2 q 2 )y - s © 2 <Vi ( L > q^) (h 2 q 2 ) 

+ pL 2 s (0 1 +0 2 ) y0 x /2 + Ls0 2 (h 2 q 2 )0 1 
f 3 = -S0 1 h 1 y0 1 - pLs0 1 V 1 (L)y0 1 - pL 2 ^ (L) s0 2 0 2 /2 
+ 302^ (L) (h 2 q 2 ) 0 2 

f 4 = -h 2 s (0 1 +0 2 > y <0 1 -t-© 2 ) - Ls0 2 h 2 0 1 0 2 
+ h 2 s0 2 <\|T^ (L) q x ) 0 2 

where s0 1 = sin(0 1 ), s0 2 = sin(0 2 ), and s(0^+0 2 ) = sin (O^+O^ . 


Similar to equation (8), the output measurement equation is 


e = Ce,. ,e,_ ,e^ , e„ ,e„ ,e Q (x 1 ),e Q (x 2 ),e Q (x 1 ),e Q (x 2 ) J 


'V V fc 2 Po Pi P2 


= C £ [y,0 lf 0 2f § T ] T 


(15) 


where 


C f - Diag[c /r, c , c , c /r, c , c , C , C ] 
1 t n c i c i Pn Pi Pi fc i 


% " c s h 


• 1 V A- 

3.1/ XX 1 


T'in 1 ,xx (x 1 ) 


il,xx 2 


(x 2 ), V in ^ xx <x 2 ) 


for i = 1, 2 


Similar to equation (9), the dynamic equations can be developed yielding 


M - M + Diagl 1^, i^n^, 0, 0, 0, 0 ] 


(16) 


C = Diag [ (K K. /R +C ) N 2 /r, (K K / R +C ) N 2 , <K K /R +C ) N 2 ,0,0,0, 
t 0 a o V 0 g 0 t l b l a l V 1 g l fc l D 1 3 1 1 g i 


0] 
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B = 


and E (t) 

a 


N K r/R 
g 0 fc 0 3 ( 

0 

0 

0 

0 

0 

0 


N K. /R 
g l fc l a ] 

0 

0 

0 

0 

0 


= (e 


0 

0 

n K /R a 

g l fc l a J 
0 
0 
0 
0 


a 0 a l a 2 


Feedback Linearization 

• To convert the equation of motion, equation (9) , to the standard first- 

order state equations, the inertia matrix M must be inverted. In view of 

equations (9) and (16) , it is seen that the matrix M is highly nonlinear and 
time variant, particularly for the articulated flexible manipulator. Direct 

inversion of the matrix M is impractical. An alternative approach is to seek a 
state variable transformation to localize the nonlinear terms to minimize the 
participation of the nonlinear terms in the matrix. Thus a state variable 
transformation is developed and written as 


£(t) = LTJ (t ) 


(17) 


where the transformation matrix L for one-arm manipulator is: 


L = 


1 0 
0 1 


0 

h. 


0 0 pL Ij/2 

and for the articulated manipulator is 


10 0 0 

010 3pL[h 11 v 12 (L)-h 12 v 11 (L)]/2 

0 0 1 0 


L = 


0 0 0 . 3pir (h 12 -pLV)/ 12 (L) /2] /2 

0 0 0 -3pL 2 (h 11 -pL\)/ 11 (L) /2] /2 


0 0 0 


0 0 

3pL[h 11 \|/ 12 (L)-h 12 V 11 (L) ] /2 0 

0 h 2 

-3pL 2 [h 12 -pny 12 (L) /2] /2 0 

3pL 2 [h 11 -piV 11 (L)/2]/2 0 

0 


2 A 

pL Z I 2 /2 
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in which only two mode shapes for each flexible arm are considered. Inserting 

~T 

equation (17) into equation (9) and premultiplying by L yields 

Mt| + CT|+KT) = L T BE, + L T f (T),T)) (18) 

GL 

where 


M = L T ML = 


also. 


m 00 (ti,ti> m 


01 


~T 

M 01 


M 


11 


~ ~T-~ 

C = i/CL 

~T — . 
K = L KL 


After transformation, the nonlinear terms in the inertia matrix M are localized 
and confined in the left-upper block Mqq which is associated with the motion of 
the rigid body only. 

Now partition equation (18) into two equations. One equation corresponds 
to the rigid body motions with nonlinear terms in the inertia matrix whereas the 
other equation represents flexural vibrations in which the nonlinear terms 
appear in the right hand side of the equation and are treated as nonlinear 
forces. The partitioned equations provide 


o 

o 

!52 

*0 

+ M 01 

Y 1 

+ c oo 

Y 0 

+ C 01 


+ K oo 

Y 0 

+ K 01 

Y 1 = B 0 E a + f 0 

(19) 

~T 

M 01 

y'o 

+ fi ll 


— T 

+ C 01 

Y 0 

+ C n 

Y 1 

+ K 01 

Y 0 

+ K X1 

Y l =E 01 B 0 E a + ^1 

(20) 


where 7g represents the rigid body state vector with the appropriate dimension, 
is the remaining flexible generalized coordinate, fg and f ^ denote the 

vectors of L T f(T),T)), and C^j, and (i = 0, 1 & j = 0,1) are 

submatrices of, M, C, K, L and B respectively. Again recall that Mgg is the only 

submatrix containing the nonlinear functions associated with the state 
variables . 
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Now, a feedback linearization approach [7] is used to linearize the 
nonlinear terms in Mgg of equation (19), which is shown in the sequel. 
Replacing in equation (19) with the one derived in equation (20) yields 


Ao“”o A Al ] + AoA)A.1^01^ Y 0 + AoA)Al*01^ Y 0 

+ AlA)AAl ] + tK Q1 -M 01 M 11 K 11 ] Y 1 = f Q - M Q1 M 11 f 1 
+ CB 0 -M 01 M-jL 0 ^B 0 ]E a (t) 


( 21 ) 


An appropriate input is introduced to force equation (21) into the form of 


M 00 Y 0 + C 00 Y 0 + C 01 Y 1 + K 00?0 + K 01 Y 1 B 0 U 


( 22 ) 


where U is a modified input vector with an appropriate dimension for feedback 

/v 

linearization process, M Q0 
terms being eliminated, and 


* ~ ~ ~-l~T 

linearization process, Mg 0 is equivalent to ( m qq -m q^ M 21 M 01 ^ “it* 1 the nonlinear 


o 

o 

o 

II 

CC 00 M 01 M 11 C 01 ] 

o> 

o 

H 

11 

AlAAAl 1 

1! 

o 

o 

AoAAKi ] 

A 

K 01 = 

Al A A Al ] 

A 

B o " 

[b oAAi^oi b o ! 


Equation (21) is identical to equation (22), if 


E a (t) B 0 A”00 [B 0 U(t) “ So Y 0 “ E 0l" 1 'l E 00 Y 0 ” E 0l Y l^ 

+ ^00^0 + E 01^1 + ^00^0 + *01^1 ( ^0 ^oAl^A 


(23) 


■laT 


where M Q = ( Mq Q - M gi^ll M 01 ) = M gg + M e w ith the matrix M g containing the 

nonlinear terms associated with the state variables. Arranging equation (23) 
produces that . 


Ea(t)=B- 1 {£ 0 U<t) - <V fi oAl ? l> + *V*00 fB 0 U(t > "^00^0 


C 0l" i 'l “ K 00^0 " K 01 T A 


(24) 
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which relates the modified input for feedback linearization process with the 
actual input. Substituting equation (24) for E a <t) into equation (20) yields 


S Jl?0 + fi u*i + £ Jl?0 + £ 11?1 + + «lltl =i h B 0 V + f N + ~ f l < 25) 


where 


f N B 01 B 0 B 0 ^*V*00 [B 0 U “ So Y 0 ^01 Y 1 ^00 Y 0 ” ^01 Y 1 ] 

“ ^Ol^ll^l 5 ^ 


Equations (22) and (25) can be combined to yield a standard second-order time 
invariant linear system by which a conventional first order equation in state 
space form is obtained. 


Output Feedback Gains 

Robust eigensystem placement [14] is used to provide two robust output 
feedback gains for the above flexible manipulators. Referring to the open-loop 
eigenvalues of the system and the desired system responses, the frequencies 
associated with the modes and the damping ratio are assigned as shown in Table 1 
for the one-arm case and Table 2 for the articulated case. Note that the 
closed-loop modal frequencies are maintained as the open-loop ones. In order to 
quickly suppress the vibrations, the damping ratio of the first mode is 
specified around 15%. The damping ratio of the second mode is slightly changed 
to 0.5%. The real eigenvalues associated with rigid bodies are located between 
-1 and -4 to minimize response time with suitable control torques. 

The output feedback gain matrices for the two manipulators are shown in 
Table 3. Because the gains for the modal velocity feedback are comparably 
small, they are deleted for practical implementation of the future experiment. 
Those gains are applied in equation (9) such that 


E a (t) 

a 



(26) 


Discussion of Results 

Several numerical simulations are performed to demonstrate the feasibility 
of the above active control algorithms. The model parameters are listed in 
Table 4 including material properties of the cart and flexible arms, and the 
conversion factors of the actuators and sensors. 


/'■- 
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The one-arm manipulator dynamics is represented by two rigid body modes and 
two flexible modes. The first two modes represent the cart linear position and 
the rotational angle of the flexible arm relative to the coordinate system 
attached on the cart. The latter two modes represent the first two bending 
modes of a fixed-free cantilever beam. Two rotary potentiometers are used to 
measure the first two modes, whereas two strain gages are used to measure the 
strains as shown in Fig. 2a. 

For the articulated manipulator, one more rigid body mode is introduced Jeo-. 

--V* S. 

describe the rotary angle of the forearm, which is measured relative to the 
local coordinate of the previous arm. Also, two flexible modes are used for the 
forearm and two strain gages are used to sense the strains along the forearm 
(Fig. 2b) . Because of the hardware limitations, velocity feedbacks of the 
flexible modes are not available and their gains should be eliminated as shown 
in Table 3. 

Based upon the linear portion of the equations (22) and (25) , the feedback- 
linearized equations are applied to perform the control schemes. In equation 
(24), the actual inputs to the motors E (t) are evaluated to remove the 

cl 

nonlinear inertia term on - the left-hand side of equation (9) . The full state 
feedback is required in this process of linearization. 

For the case of one-arm flexible manipulator, one task is to move the cart 
from positive 1.5 meters to a reference origin while simultaneously rotating the 
arm from 60 degrees to zero degree. Figure 4 shows the cart displacement, the 
relative root angle of the arm, the root strain, the relative displacement of 
the tip and the required torques of control inputs for this desired task. 
Generally speaking, it takes about 4 sec for this controller to complete the 
task. For the case of articulated flexible manipulator, two tasks are 
specified which are shown in Fig. 5. The controller finishes both tasks within 
8 seconds. The required control torques of each simulation are feasible for the 
actuators in the future experiment . 


Concluding Remarks 

/ 

The active control of the articulated flexible manipulator carried by a 
translational cart in the planar motion has been investigated. The nonlinear 
dynamic equations for the manipulator are derived. The time-variant inertia 
matrix is linearized without approximation by using a suitable feedback 
linearization approach. The first-order state equations are then generated for 
controller design. 

To design a controller to move the manipulator in an attainable workspace 
while suppressing the bending vibration of the flexible arms simultaneously, a 
robust pole placement approach is employed. It leads to two reliable output 
feedback gains which not only meet the need of the position control strategy but 
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also provide the system robustness. Several computer simulations for the 
flexible manipulator are conducted to demonstrate the feasibility of the 
controller design. Experimental tests are suggested in order to verify the 
numerical results disscussed herein. 
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Table 1: Frequency (Hg) and damping ratio for the one-arm manipulator 


Open-loop 

Closed-loop 

(0° 

c° 


(0 

C 

O 

O 



1.5782 


0.0 



1.5782 


9.0656 



2.3333 


33.7940 



2.3333 


4.4287 

13.2867 

% 

4.3277 

15.0 % 

27.8106 

1.9230 

% 

26.8212 

0.5 % 


Table 2 : Frequency (Hz) and damping ratio for the articulated manipulator 


Open-loop 

Closed-loop 

co° 

C° 


CO 

C 


O 

O 



2.0613 



o 

o 



2.0613 



o 

o 



2.1332 



6.8068 



2.1332 



33.7053 



3.1701 



34.1371 



3.1701 



1.8509 

24.0858 

% 

1.8299 

17.0 

% 

6.3521 

5.2401 

% 

6.3581 

17.0 

% 

21.3261 

2.2987 

% 

20.6098 

0.5 

% 

35.3678 

0.4767 

% 

35.1438 

0.5 

% 


15 







Table 3 ; Output feedback gains 


(1) Gain for the one-arm manipulator: 


G 


-6.5560 -1.0032 -9.0686 -5.7710 6.3015 

-0.8985 -0.9722 -1.8692 -0.0205 -1.0264 


-1.3067 0 0 

2.4745 0 0 


(2) Gain for the two-arm articulated manipulator: 


G 


-13.7232 

-2.1394 

0.5658 

3.3502 

91.3450 

-27.7692 

- 3.1973 

-3.9846 

-0.7586 

-0.3899 

38.3708 

- 7.8262 

- 0.8363 

-1.1753 

-1.3848 

2.2190 

55.2495 

- 7.1356 


170.2792 0.0711 

31.8523 -3.6552 

3.0059 -0.9948 


-3.9826 -1.0462 
-0.5281 -1.1671 
-1.2351 2.1654 


0 0 0 0 
0 0 0 0 
0 0 0 0 
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Table 4 : Model parameters 


Motors : 


Cart 

motor: 


(2) Arm 

motor: 


K t 

Z 0 

= 0.0346 

N.m/amp 

S 

= 9.3X10 -3 

N.m/amp 

\ 

= 0.0342 

Volt-sec/ rad 


= 9.2X10 -3 

N . m/ amp 

\ 

= 4 

ohm 


= 1.1 

ohm 

m 0 

= 4.7X10 -6 

„ 2 
Kg-m 

s 

= 2.3X10 -6 

Kg-m 2 

N 

?0 

= 210 


N 

*1 

= 210 





m l 

= 0.92 

Kg 


Steel beam: 


L =1.0 

m 

El = 0.71 

N-m 2 

p = 0.47916 

Kg/m 

h = 0.041X10 -2 

m 


Rigid cart : 


m = 0.588 
c 

K< 
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Appendix 


For the one-arm flexible manipulator shown in Fig. 1, the kinetic energy T 
and the potential energy V for small bending amplitude can be expressed as 

2T = my 2 + Jq p[ y + <5^3^ - Y x ].[ y + SjXXj. - y 1 ] dx 1 (Al) 

2V - EK y li>vti l 2 d*! 1*2) 

where is a vector tangent to the longitudinal axis of the base of flexible 
arm. 

Moreover, the distributed coordinates are expanded in an orthogonal basis 
of assumed mode shapes as 

y^x^t) = ^(x,) q^t) ;Vi=<V 1;L * • • -'V lni > and q^=(q 1;L , . . . ,q ln ^) (A3) 

where ^(x^) is a vector of assumed mode shapes relative to a spatial 

coordinates derived from the fixed-free cantilever beam's boundary condition 
problem, q-^t) are generalized coordinates [8-10], and n 1 is an appropriate 

number of assumed modes. 

Inserting equation (A3) into equations (Al) and (A2) yields 


2T = my 2 + I^ 2 + pLy 2 + m li j^li^l j + P^cG^y 

n- n m • 


- 2 i5i p ii^ii 0 i - 2 c 0 iiii h ii c Jiiy 


(A4) 


2V = 3l ji^lij^lj 

where 

X 1 " f 0 P x 1 dx l 

m iij = J o ^i 

P li " P x iV li (^ 1 ) dx ± 
h !i = ! 0 PVii^i) 
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‘lij 


= Jj „ V- 


li, x 1 x 1 r l j, 


dx. 


for i, j=l, 2, . . . , , n 1 


To simplify the state variables in the above equations, denote ^g=y, ^> 1 ^ 1 ' 

^ 1+ .-q li , for i=l,2, . . . . ,n x , Q 0 =T o' Q 1 =T 1' Q lfi =0, for i=1 / 2 ' • - • • ' 1 x • via the 
Lagrange's equation of motion [10], we obtain 


d[ di/dk L .]/dt - 3T/3^ i + 3v/3^ = Q i i=0,l, 


• • • / n -i 


This leads to the equations of motion as shown in equations (3) -(6) . 

Similarly, for the articulated manipulator shown in Fig. 3, the kinetic 
energy and the potential energy can be derived as 


2T = my 2 + 

I} p ( y + S 1 xx 1 - 

• y, )( 

y + S^Xx^ - 

y 1 ) dx 1 


+ 

Jj P( y + + 

t 2 xx 2 

- y 1 CL) - y 2 

) 



( y + j^XL + 

®2 Xx 2 

- y x (D - y 2 

) dx 2 

(A6) 

2V = Jq Ell 

yi,x lXl > 2 ^1 + 

Ell 

y2,x 2 x 2 )2 dx 2 

(A 7) 


Expanding equations (A6) and (A7) provides 


2T = 


n l n l 

my 2 + 4I 1 0 2 + I 2 0 2 + 2pLy 2 + i g 1 ^ 


n 2 n 2 

+ i§l j£l m 2^ 


ij q 2i q 2j “ 2 i=l P li q li 9 l " 2 i=l P 2i q 2i 9 ' 


‘2 . . 


+ 3pL c9 1 0 1 y - 2c0 1 .2 1 h li q li y - 2c (O^) J^^y 
+ P L i§i jiiVi i ( L >V 1 j + pL 2 c(0 1 +0 2 )y0 2 

n l . . n l . . 

- 2pLc0 li Z 1 V li (L)q li y + - 2pL 2 < L) q li _0 1 

n 2 n l 

- 2Lce 2i 5 1 h 2i q 2i 0 1 - Pt 2 ce 2i | 1 V li (L)q li e 2 

n l n 2 . . 

+ 2c9 2i=l j=l Vii(L)h 2jqii q 2j 


(A8) 


n i n l 


n 2 n 2 


2V =ill jSl K lij q li q lj + ih jSi K 2ij q 2i q 2j 


(A9) 


where 
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J 1 = ; o P X 1 dx l 

X 2 = J 0 P x 2 ^2 

m lij = ! 0 P^ li (x 1 , V 1 j (x 1 ) dx l 

m 2i j = ! 0 PV 2i <x 2 )V 2j (^ 2 ) dx 2 

p li = J 0 P^iVi i (x 1 ) dx 1 

P 2i = ^0 P x 2'* / 2i (x 2 ) ^2 

h li = J 0 P^u^i) 

h 2i = ! 0 P'» f 2i (x 2 ) ^2 

K lij - ^0 EI '* ; li,x 1 x 1 X * / lj,x 1 x 1 

K 2ij - *0 EI ^2i, x 2 X2^ / 2 j, x 2 x 2 dx 2 


where and n 2 are the numbers of the -shape functions for the first arm and the 
forearm respectively. 
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(TOP VIEW) 


Figure 1: The coordinate system and notations of the cart and the flexible arm 
for the one-arm manipulator. 
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Figure 4: Numerical simulation of the o 
displacement and 60° manipula 
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Figure 5a: Numerical simulation of the articulated manipulator; 1.5 m cart 

displacement, + 60° for the first arm and - 60° for the forearm 
manioulat ion . 
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